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DESCRIPTION 
CONTROL METHOD FOR TWIN SYNCHRONIZATION 



<Technical Field> 

The present invention relates to an applied machine 
applied to a high speed positioning control for gantry 
type machines such as a high speed conveying machine or 
other machines , and more particularly to a control method 
for high speed and highly accurate uses . 

<Related Art> 

In recent years , in the high speed and highly accurate 
conveying machine of an industrial machine field, what 
is called a gantry type machine in which two axes are 
synchronously operated has been introduced. When a 
synchronization between the axes is carried out in the 
gantry type machine, a high speed and highly accurate 
synchronous operation is hardly realized in a machine 
low in its rigidity and having torsion or backlash. 

Usually, to reduce a deviation between the two axes, 
a method has been employed in which the same position 
command and the speed command are respectively 
distributed to the axes from a controller to adjust the 
gain of a position controlling and speed controlling loop 
of each axis to a high gain, an integration is utilized 
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in the position controlling and speed controlling loop 
to eliminate the deviation during a control and a speed 
feed forward process is carried out to improve a 
responsiveness for each axis and reduce the deviation 
between the two axes (for instance, see JP - A- 1 1 - 3 0 5 8 3 9 ) . 

However, in the case of a gantry type machine 
structure, below-described problems arise. 

(1) Since the two axes are mechanically fastened to each 
other, the machine with high rigidity that can withstand 
a high gain is hardly obtained. 

(2) There are necessarily an installation error of the 
above -described machine , an attaching error of a position 
sensor, distortion and backlash of each axis. 

(3) Although the gain is increased to reduce the 
deviation between the two axes , the two axes interfere 
with each other during a control operation and torque 
outputted respectively from the axes causes a disturbance 
to give an adverse effect to the vibration of a pedestal 
or accuracy. 

Thus, it is an object of the present invention to 
provide a twin synchronization method that can avoid the 
above-described problems for a machine having a gantry 
type structure and can easily realize a high speed and 
highly accurate operation. 
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<Disclosure of the Invention> 

To achieve the above - described object, according 
to an aspect of the present invention, there is provided 
a control method for a twin synchronization in which two 
motors for driving two axes mechanically fastened to each 
other by a fastening part are synchronously operated, 
the control method including the steps of: operating one 
of the two axes at low speed by a position control and 
allowing the other axis to freely run and follow the one 
axis and perform a return to the origin; measuring a 
positional deviation between the one axis and the other 
axis at an arbitrary pitch; storing the positional 
deviation corresponding to a position where the one axis 
travels in a data base as a function; directly disturbing 
one position command to the one axis as a main position 
command; and distributing the position command to the 
other axis as a position command corrected by using the 
function stored in the data base to perform an operation. 

In order to reduce the synchronization error of the 
two axes, it is important to firstly determine how a return 
to the origin operation is performed. In this case, when 
the return to the origin operation is firstly performed, 
if the two axes are electrically operated at the same 
time under a speed control and a position control, a motor 
of each axis gives a stress to a machine side . Accordingly, 
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characteristics such as a distortion of a machine itself 
cannot be grasped. Therefore, in driving upon return to 
the origin operation, a main axis (either of the two axes 
may be used) is operated at low speed by controlling a 
position and the other axis is allowed to freely run and 
follow the main axis and the return to the origin operation 
is carried out by a single sided drive. 

Originally, inthecaseof a mechanically and ideally 
fastened structure, the deviation between the two axes 
is to be 0 at any position . However, in an actual machine , 
since there are necessarily an installation error, the 
attaching error of a position sensor, a distortion and 
backlash of each axis, the deviation between the two axes 
necessarily arises depending on positions. Therefore, 
the deviation between the two axes is automatically 
measured at the arbitrary pitch and recorded in the data 
base. Also at this time, when the two axes are 
electrically operated at the same time under the speed 
control and the position control like during the return 
to the origin operation, the motor of each axis gives 
a stress to the machine side, so that the characteristics 
such as the distortion of the machine itself cannot be 
grasped. Thus, in driving during the measurement, the 
main axis is operated at low speed by controlling the 
position and the other axis is allowed to freely run and 
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follow the main axis to measure the deviation between 
the two axe s . 

To synchronously operate the two axes, one position 
command is distributed to the two axes as the main position 
command. The main position command to be distributed is 
directly distributed to the first axis. The function 
recorded in the data base is used, the main posit ion command 
is used as an input and an output thereof is used, so 
that the main position command - an output value of the 
function = the position command of the other axis (the 
position command to the second axis) , that is, a position 
command to which a correction considering a torsion part 
is added is distributed to the other axis. 

A high speed and highly accurate synchronization 
control that cannot be realized by a usual control system 
can be realized by the above - described means without 
receiving an adverse effect due to the rigidity or the 
distortion of a machine system. 

Further, according to an enhancement , there is 
provided the control method for a twin synchronization, 
wherein the deviation measured at the arbitrary pitch 
undergoes a linear interpolating process in the function 
to output the obtained deviation. 

Since the deviation measured at the arbitrary pitch 
is arbitrarily changed in accordance with a moving 
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distance, the linear interpolating process is carried 
out in the function to output the obtained deviation. 

Further, according to another enhancement there 
is provided the control method for a twin synchronization, 
wherein in the position command to the other axis , a travel 
speed is employed as a parameter to move forward the phase 
of a corrected value . 

When the travel speed of the machine is increased, 
a processing time for carrying out a correction itself 
is undesirably delayed. Accordingly, a function for 
using the travel speed as the parameter to move forward 
or lead the phase of the corrected value is employed to 
perform the synchronization control. 

Further, according to another aspect of the present 
invention , there is provided the control method for a 
twin synchronization, further including the steps of: 
detecting the position of a center of gravity of the 
fastening part; preparing a function for forming an 
inertia compensating gain of each axis by using a position 
signal as an input; changing the inertia compensating 
gain in the position of the center of gravity of the 
fastening part; and adding a necessary torque calculated 
on the basis of an acceleration obtained from the position 
commands of the two axes and a mass of each axis to a 
torque command . 
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When an X-axis by which a Yl axis is fastened to 
a Y2 axis is movable, the position of the center of gravity 
of the machine moves, so that synchronization accuracy 
is deteriorated. To inert ia- correct the deterioration 
of the synchronization accuracy, a position where the 
X-axis moves is grasped. A funct ion for forming the inertia 
compensating gain Ktffx is prepared by using a position 
signal as an input to change the inertia compensating 
gain Ktffx at the position of the X-axis. An inclination 
is based on a change of a load applied to the axis in 
accordance with the change of the center of gravity. 

Thus, a high speed and highly accurate 
synchronization control that cannot be realized by a usual 
control system can be realized without receiving an 
adverse effect due to the rigidity or the distortion of 
a machine system and the change of the center of gravity 
due to the movement of the X-axis of the fastening part. 



<Brief Description of the Drawings> 

Fig. 1 A-C shows a structure in an embodiment of 
the present invention. Fig. 1(A) is a front view, Fig. 
KB) is a side view and Fig. 1{C) is a plan view. 

Fig. 2 is a control block diagram in a first 
embodiment of the present invention. 

Fig . 3 is a flowchart showing a procedure for forming 
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a torsion part correcting function in the first embodiment 
of the present invention. 

Fig. 4 is a diagram showing an output example of 
a torsion correcting amount in the first embodiment. 

Fig. 5 is a diagram showing a relation between a 
main position command, a main torque command and a torque 
command in a correcting side when atorsionisnot corrected 
in the first embodiment of the present invention. 

Fig. 6 is a diagram showing a relation between the 
main position command, the main torque command and the 
torque command in the correcting side when the torsion 
is corrected in the first embodiment of the present 
invention . 

Fig. 7 is an inertia correction control block diagram 
in a second embodiment of the present invention. 

Fig. 8 is a detailed explanatory view for forming 
an inertial correcting gain in the second embodiment of 
the present invention. 

Fig. 9 is a diagram showing a relation between the 
main position command, the main torque command and the 
torque command in the correcting side when there is not 
an inertia correction control in the second embodiment 
of the present invention. 

Fig. 10 is a diagram showing a relation between the 
main position command, the main torque command and the 
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torque command in the correcting side when there is the 
inertia correction control in the second embodiment of 
the present invention. 

In the drawings, reference numeral 1 designates a 
controller. 2, 2-1 and 2-2 designate servo drives. 3 
designates a moving element. 4 designates a stator. 5 
designates a linear scale. 6 designates a fastening jig. 
7-1 designates a motor of a first axis. 7-2 designates 
a motor of a second axis. 11 designates a main position 
command generating part . 12 designates an interpolating 
part. 13 designates a phase lead compensating part. 14 
designates a function part for generating a torsion part 
corrected value. 15 and 16 designate differential 
operating parts . 17 designates a scale converting part . 
18 designates a gain amplif ier . 21 designates aposition 
loop control part. 22 designates a speed loop control 
part. 23 designates a current loop control part. 24 
designates a linear scale. 31 designates a main position 
command generating part . 32 designates an interpolating 
part . 33 and 34 designate differential operating parts . 
35 and 37 designate inertia calculating parts. 36 
designates a yl-axis torque FF compensating part. 38 
designates a y2-axis torque FF compensating part 39 
designates an X-axis position detecting part. 40 
designates a function part for generating an inertia 
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compensating gain. 41 and 42 designate inertia 
compensating parts . 

<Best Mode for Carrying Out the Invention> 

Now, a first embodiment of the present invention 
will be described below by referring to the drawings. 

Fig. 1 shows the structure of a first embodiment 
of the present invention formed by using a linear motor. 
Fig. 1(a) is a front view, Fig. 1(b) is a side view and 
Fig. 1(c) is a plan view. In the drawing, reference 
numeral 1 designates a controller, 2 designates a servo 
drive, 3 designates a moving element , 4 designates a stator , 
5 designates a linear scale and 6 designates a fastening 
jig for mechanically fastening two axes together. 

Fig . 2 is a control block diagram of this embodiment . 
In Fig. 2, the controller 1 includes the main position 
command generating part 11, the interpolating part 12, 
the phase lead compensating part 13, the function part 
14 for generating a torsion part corrected value, the 
differential operating parts 15 and 16, the scale 
converting part 17 and the gain amplifier 18. Further, 
the servo drives 2-1 and 2-2 include the position loop 
control parts 21, the speed loop control parts 22 and 
the current loop control parts 23. In the drawing, 7-1 
designates the motor of the first axis, 7-2 designates 
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the motor of the second axis and 24 designates the linear 
scales for respectively detecting the positions of the 
moving elements of the motors 7-1 and 7-2. 

In the control block diagram of Fig. 2, in the 
controller 1 , a main position command is f irst ly generated 
by the main position command generating part 11 . The main 
position command is interpolated in the interpolating 
part 12 to generate a main position command from hour 
to hour. To the servo drive 2-1 of the first axis, the 
main position command is generated for a main axis, the 
position command is two-stage time differentiated in the 
differential operating parts 15 and 16 of two stages, 
the differentiated position command is scale - converted 
in the scale converting part 17 and the converted position 
command is multiplied by a gain Ktf f in the gain amplifier 
18. Thus, T-FF (torque feed forward) is generated. 

To the second servo drive 2-2 of the second axis, 
the position command of the main axis from hour to hour 
is used as an input and a torsion part correcting function 
generated in the function part 14 for generating a torsion 
part corrected value is used to generate a torsion 
correcting position command corresponding to the position 
command that passes . Thus , the main position command from 
hour to hour - the torsion correcting position command 
= a position command of the second axis is generated and 
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outputted to the servo drive 2-2 of the second axis. 

Fig. 3 is a flowchart showing a procedure for 
generating a torsion part correcting function in the 
function part 14 for generating a torsion part corrected 
value . 

Step 1: Return to the origin 

The position of the first axis as the main axis is 
controlled and the second axis as the other axis is allowed 
to freely run and reset to zero. 

Step 2: Measurement of torsion data between two axes 

A method is carried out in which a deviation between 
two axes (position FB of first axis - position FB of second 
axis) is automatically measured at an arbitrary pitch 
to store the deviation in a data base. At this time, when 
the two axes are electrically operated at the same time 
under a speed control and a position control like during 
the return to the origin operation, a motor of each axis 
gives a stress to a machine side. Thus, characteristics 
such as the distortion of the machine itself cannot be 
grasped. Accordingly, in driving during the measurement , 
the main axis (any one of the two axes may be used) is 
operated at low speed by controlling a position and the 
other axis is allowed to freely run and follow the main 
axis to measure the deviation of the two axes. 
Step 3: Generate function of torsion data 
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A function is generated that has a travelling 
position as an input and the deviation between the axes 
measured in the step 2 as an output. Since the input 
arbitrarily changes depending on a moving distance, the 
deviation measured at the arbitrary pitch in the step 
2 is subjected to a linear interpolating process in the 
function and the obtained deviation is outputted. 

In order to improve the responsiveness upon 
acceleration and deceleration, the position commands are 
simultaneously outputted to the first axis and the second 
axis in the servo drive 2-1 and 2-2 sides. As such a 
synchronization control method, a position following 
control method in a position synchronization type speed 
control system disclosed in JP -A- 0 6 - 2 8 0 3 6 that is filed 
by the applicant of the present invention may be employed. 

For a case in which a correction cannot be made only 
by a quantity of correction generated by an automatic 
measuring operation, a function for manually adding a 
quantity of correction as an of f set value is also prepared . 
Further, for a case in which when the travelling speed 
of the machine is increased, a processing time for 
performing a correction itself is undesirably delayed, 
a function for leading the phase of a corrected value 
by using the travelling speed as a parameter is also 
prepared . 
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Fig . 4 is a graph showing a torsion corrected quantity 
specifically measured by the procedure shown in Fig. 3. 

A designates a quantity of torsion measured by 
actually attaching a laser displacement gauge to the 
machine. B designates a quantity of torsion measured by 
the procedure shown in Fig. 3 . Since the above -described 
offset quantity is added to the former, the quantity of 
torsion is the more offset for the offset quantity. 
However, it is understood that the quantity of torsion 
of the machine can be accurately measured by the method 
shown in Fig . 3 . 

Figs. 5 and 6 respectively show relations between 
a main position command, a main torque command and a torque 
command in a correcting side. Fig. 5 shows an example 
when amethodof this embodiment isnotused. Fig. 6 shows 
an example when the method of this embodiment is used. 
In Fig. 6, it is understood that the deviation between 
the two axes is extremely improved as high as about 1/3. 
As described above, the method of the present invention 
is used so that a synchronization control that cannot 
be realized hitherto can be realized in the gantry type 
machine using the linear motor. 

Now, a second embodiment of the present invention 
will be described below. 

Fig. 7 is a block diagram of a controller showing 
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a second embodiment of the present invention. 

In Fig. 7, the controller 1 includes a main position 
command generating part 31, an interpolating part 32, 
differential operating parts 33 and 34, inertia 
calculating parts 35 and 37, a yl-axis torque FF (feed 
forward) compensating part 36, a y2-axis torque FF 
compensating part 38, an X-axis position detecting part 
39, a function part 40 for generating an inertia 
compensating gain and inertia compensating parts 41 and 
42 . 

In the second embodiment, an inertia correction when 
an X-axis moves is controlled by a torque FF (feed forward) 
compensat ion . 

In a twin synchronization type (a gantry type) 
machine, when a fastening jig part 6 (X-axis) moves and 
twin driving parts (Yl and Y2 axes) are synchronously 
operated, the pos ition of a cent er of gravity moves . Thus, 
synchronization accuracy is deteriorated. 

Thus, to inertia-correct the deterioration of 
accuracy due to the movement of the position of a center 
of gravity of the machine, a position where the X-axis 
moves is grasped by the X-axis position detecting part 
39. A position signal thereof is used as an input to 
prepare an inertia compensating gain Ktf fx in the function 
part 40 for generating an inertia compensating source 
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and change the inertia compensating gain Ktffx at the 
position of the X-axis (see Fig. 7(a)) . 

The inclination of the inertia compensating gain 
Ktffx is based on the change part of a load exerted on 
the axis due to the change of a center of gravity. That 
is, an object of the X-axis moves to change the center 
of gravity of the X-axis, so that the load exerted on 
the Yl and Y2 changes. Accordingly, a correction is 
carried out only on the basis of the change part. 

As for the inclination, a neutral position of the 
X-axis is firstly subtracted from a current position of 
the X-axis. The obtained value is multiplied by an 
adjusting coefficient, namely, a coefficient for 
adjusting so that an outputted quantity of corrected 
torque corresponds to an actual entire torque command. 
To apply the inclination to the Yl and Y2 axes in accordance 
with the position of the X-axis, for the Yl , the obtained 
value is subtracted from 1.0, and for the Y2 , 1.0 is added 
to the obtained value, as shown in Fig. 8, so that inertia 
compensating coefficients Ktffyl and Ktffy2 of the Yl 
and Y2 axes are generated. 

The Ktffyl and Ktffy2 are used to calculate masses 
Wwyl' and Wwy2 ' when the X-axis moves in accordance with 
a following formula in the inertia compensating parts 
41 and 42 . Wwyl and Wwy2 designate masses of the Yl axis 
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and the Y2 axis before the axes move. 
Wwyl' = Wwyl x Ktffyl 
Wwy2 ' = Wwy2 x Ktffy2 

An actual torque FF command is generated in the main 
position command generating part 31. A main position 
command interpolated in the interpolating part 32 is 
two-stage time differentiated in the differential 
operating parts 33 and 34 to generate an acceleration 
aref . In the inertia calculating parts 35 and 37, the 
acceleration aref, the masses Wwyl' and Wwy2 after the 
Yl axis and the Y2 axis move, the mass Wt of the fastening 
jig 6, the mass Wm of a motor and the torque FL of the 
load are used to calculate a torque necessary upon 
operation in accordance with following formulas. 
( ( (Wwyl ' + Wt + Wm) x acceleration aref + FL) /rated thrust) 
X 100 % 

( ( (Wwy2 ' + Wt + Wm) x acceleration aref + FL) /rated thrust) 
X 100 % 

The torque calculated in such a way is inputted to 
the yl-axis torque FF compensating part 36 and the y2 - 
axis torque FF compensating part 38 as compensating torque 
and added to a torque command of a driver side to improve 
the synchronization accuracy. 

Figs. 9 and 10 show relations between the main 
position command, a main torque command and a torque 
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command in a correcting side. Fig. 9 shows an example 
when a method of this embodiment is not used. Fig. 10 
is an example when the method of this embodiment is used. 
In Fig. 9, when the X-axis is movable, a quantity of a 
torque FF of the Yl does not correspond to an actually 
required torque command of the Yl, a deviation between 
the two axes is generated. In Fig. 10, since the quantity 
of the torque FF of the Yl corresponds to the actually 
required torque command of the Yl in accordance with the 
correction, it is understood that the deviation between 
the two axes is extremely improved as high as about 1/5. 

< Industrial Appl icabi li ty > 

As described above, according to the present 
invention, one of the two axes is operated at low speed 
by a position control and the other axis is allowed to 
freely run and follow the one axis and a return to the 
origin is performed. A positional deviation between the 
one axis and the other axis is measured at an arbitrary 
pitch and the positional deviation corresponding to a 
position where the one axis travels is stored in a data 
base as a function. One position command is directly 
distributed to the one axis as a main position command 
and the position command is distributed to the other axis 
as a position command corrected by using the function 
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stored in the data base to perform an operation. Thus, 
a twin synchronization control that can realize a high 
speed and highly accurate operation can be easily 
realized . 

Further, the position of a center of gravity of the 
fastening part is detected. A function for generating 
an inertia compensating gain of each axis is prepared 
by using a position signal thereof as an input. The 
inertia compensating gain is changed in the position of 
the center of gravity of the fastening part. A necessary 
torque calculated on the basis of an acceleration obtained 
from the position commands of the two axes and a mass 
of each axis is added to a torque command. Thus, since 
a quantity of the torque feed forward of one of the two 
axes corresponds to an actually required torque command, 
the deviation between the two axes can be extremely 
reduced . 
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